1 1 . A method of planning at least one path for an object in a state space from a 

2 starting position to a goal position to avoid a plurality of static and/or dynamic objects, 

3 comprising: 

4 (a) associating predetermined attributes with the plurality of static objects and/or 

5 the plurality of dynamic objects located in the state space; 

6 (b) generating a probabilistic tree in the state space including a plurality of 

7 branches extending from the starting position of the vehicle towards the goal position 

8 located in the state space; and 

9 (c) extending the plurality of branches of the probabilistic tree towards the goal 

1 0 position located in the state space based on at least one of a plurality of random tree 

1 1 extension rules and a plurality of deterministic tree extension rules until satisfying a 

1 2 predetermined stopping condition; and 

1 3 (d) evaluating at least a first branch of the plurality of branches of the probabilistic 

14 tree for determining whether the first branch of the plurality of branches of the 

1 5 probabilistic tree satisfies predetermined trajectory path constraints. 

1 2. The method of claim 1 , wherein if the first branch of the plurality of branches of the 

2 probabilistic tree conforms to the predetermined trajectory path constraints, the method 

3 further includes: 

4 (e) declaring the first branch of the plurality of branches of the probabilistic tree as 

5 the at least one preferred trajectory path for the vehicle in the state space; and 

6 (f) controlling the vehicle to follow the at least one preferred trajectory path in the 

7 state space for moving the vehicle from the starting position towards the goal position in 

8 the state space. 
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1 3. The method of claim 2, wherein if the first branch of the plurality of branches of the 

2 probabilistic tree fails to conform to the predetermined trajectory path constraints, the 

3 method further includes: 

4 (g) extending the plurality of branches of the probabilistic tree further based on 

5 the at least one of the plurality of random tree extension rules and the plurality of 

6 deterministic tree extension rules until at least one branch of the plurality of branches of 

7 the probabilistic tree satisfies the predetermined stopping condition and conforms to the 

8 predetermined trajectory path constraints. 

1 4. The method of claim 3, further including: 

2 (h) declaring the at least one branch of the plurality of branches of the 

3 probabilistic tree that couples the starting position to the goal position and that conforms 

4 to the predetermined trajectory path constraints as the at least one preferred trajectory 

5 path for the vehicle in the state space; and 

6 (i) controlling the vehicle to follow the at least one preferred trajectory path in the 

7 state space for moving the vehicle from the starting position towards the goal position in 

8 the state space. 

1 5. The method of claim 4, further including: 

2 (j) repeating one or more of steps (a)-(i) at predetermined time intervals as the 

3 vehicle moves along the at least one preferred trajectory path toward the goal for updating 

4 the at least one preferred trajectory path to compensate for motion of the plurality of 

5 dynamic objects. 

1 6. The method of claim 1 , wherein satisfying the predetermined stopping condition 

2 includes at least one of satisfying a predetermined time constraint and satisfying a 

3 predetermined travel distance constraint. 
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1 7. The method of claim 1 , wherein associating predetermined attributes with the 

2 plurality of static objects and the plurality of dynamic objects located in the state space 

3 includes associating at least one of a position value, a velocity value, a direction value, an 

4 acceleration value and a time value. 

1 8. The method of claim 1 , wherein generating the probabilistic tree in the state space 

2 further includes: 

3 extending each of a first plurality of edges a first predetermined distance and 

4 direction from the starting position in the state space to each of a corresponding first 

5 plurality of nodes based on the plurality of random tree extension rules and the plurality 

6 of deterministic tree extension rules for forming first segments of each of the plurality of 

7 branches of the probabilistic tree. 

1 9. The method of claim 8, further including: 

2 extending at least one of a next successive plurality of edges from each of the first 

3 plurality of nodes a second predetermined distance and direction in the state space to each 

4 of a corresponding next successive plurality of nodes based on the plurality of random tree 

5 extension rules and the plurality of deterministic tree extension rules for forming next 

6 successive segments of each branch of the plurality of branches of the probabilistic tree. 

1 1 0. The method of claim 9, further including: 

2 repeating cyclically extension of each branch of the plurality of branches of the 

3 probabilistic tree until at least the first branch of the plurality of branches of the 

4 probabilistic tree satisfies the stopping condition. 
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1 11. The method of claim 1 0 S further including: 

2 evaluating whether extension of one or more branches of the plurality of branches of 

3 the probabilistic tree violate object avoidance constraints; and 

4 suspending further extension of the one or more branches of the plurality of 

5 branches if a determination is made that extension of the one or more branches of the 

6 plurality of branches of the probabilistic tree violate the object avoidance constraints. 

1 12. The method of claim 1 1 , further including: 

2 resuming extension of the one or more branches of the plurality of branches if a 

3 determination is made that extension of the one or more branches of the plurality of 

4 branches of the probabilistic tree no longer violates the object avoidance constraints. 

1 13. The method of claim 1 , wherein extending the plurality of branches of the 

2 probabilistic tree based on the plurality of random tree extension rules includes at least one 

3 of extending each branch into the state space that is void of the plurality of static objects 

4 and the plurality of dynamic objects and extending each branch into the state space that is 

5 void of other branches of the plurality of branches of the probabilistic tree. 

1 14. The method of claim 1 , wherein extending the plurality of branches of the 

2 probabilistic tree based on the plurality of deterministic tree extension rules includes at least 

3 one of extending each branch towards the goal and extending each branch in a straight 

4 line with respect to a previous extension of each branch. 

1 15. The method of claim 1 , wherein determining whether the first branch of the plurality 

2 of branches of the probabilistic tree satisfies the predetermined trajectory path constraints 

3 includes determining whether the first branch of the plurality of branches of the 

4 probabilistic tree satisfies at least one of a maximum travel distance value, a maximum turn 

5 angle value, a minimum distance value to the plurality of static objects and the plurality 

6 of dynamic objects. 

32 



1 16. A path planning method for a vehicle, comprising: 

2 defining a state space including an initial start position and a goal position; 

3 generating a plurality of paths from the start position to the goal position over time 

4 on a node by node basis based upon a set of rules including at least one of a deterministic 

5 rule, a randomness rule, and a probabilistic rule; 

6 assigning locations to objects in the state space over time based upon respective 

7 probability distributions; and 

8 selecting a first one of the generated plurality of paths. 

1 1 7. The method according to claim 1 6, further including terminating ones of the 

2 plurality of paths that are not feasible at a given node in the state space. 

1 18. The method according to claim 17, further including terminating paths based upon 

2 one or more of impact with an object, region avoidance, g- force limitations, sensor 

3 information, path distance, path time, number of turns, altitude change limitations, straight 

4 path desirability, object location confidence level, turning radius limitations, and turning 

5 penalties. 

1 19. The method according to claim 16, further assigning a confidence level to object 

2 locations. 

1 20. The method according to claim 16, further including assigning object state 

2 information including one or more of position, heading, velocity, acceleration, turning 

3 radius, acceleration limit, velocity limit, g-force limit, and location confidence level. 

1 21 . The method according to claim 20, further including assigning a probability 

2 distribution to one or more components of the object state information. 
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1 22. A method of adaptive path planning for a vehicle, comprising: 

2 defining a state space for the vehicle and a plurality of objects; 

3 setting a root node to initial state for the vehicle; 

4 generating a plurality of paths comprising node-to-nod branches from a vehicle start 

5 location to a goal location; 

6 examining each of the branches to determine whether stopping conditions are 

7 satisfied; 

8 generating first ones of the branches using deterministic rules; 

9 generating second ones of the branches using random extension rules; determining 

10 whether first ones of the plurality of branches should terminated; and selecting a first one of 

1 1 the plurality of paths that extend to the goal location. 

1 23. The method according to claim 22, further including assigning state information to 

2 the plurality of objects including one or more of position, heading, velocity, acceleration, 

3 turning radius, acceleration limit, velocity limit, g-force limit, and location confidence 

4 level. 
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1 24. A system to plan a path to a vehicle, comprising: 

2 a workstation including 

3 a processor coupled to a memory containing instructions to enable the 

4 steps of: 

5 defining a state space for the vehicle and a plurality of objects; 

6 setting a root node to initial state for the vehicle; 

7 generating a plurality of paths comprising node-to-nod branches from a vehicle start 

8 location to a goal location; 

9 examining each of the branches to determine whether stopping conditions are 

10 satisfied; 

1 1 generating first ones of the branches using deterministic rules; 

12 generating second ones of the branches using random extension rules; 

1 3 determining whether first ones of the plurality of branches should terminated; and 

14 selecting a first one of the plurality of paths that extend to the goal location. 

1 25. The system according to claim 24, further including program instructions to provide 

2 state information to the plurality of objects including one or more of position, heading, 

3 velocity, acceleration, turning radius, acceleration limit, velocity limit, g-force limit, and 

4 location confidence level. 

1 26. The system according to claim 24, further including program instructions to 

2 download the selected path to the vehicle. 
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